#!/usr/bin/env python

import roslib; roslib.load_manifest('team4')
import rospy
from lift_test import Tray 
#from test_import import *

# Really, this should be done as a state machine.

if __name__ == "__main__":
   rospy.init_node("team4_demo")
   
   rospy.loginfo("Beginning team 4 demo")
   rospy.loginfo("Creating all class instances")
   tray = Tray()
   
   rospy.loginfo("Going to dirty table to pick up tray. ")
   #tray.pick_up_tray()
   
   rospy.loginfo("Going back to clean table")
   
   rospy.loginfo("Scanning table to find all objects and free space")
   
   rospy.loginfo("Putting tray down")
   
   rospy.loginfo("Stacking items on tray")
   
   rospy.loginfo("Picking up tray")
   #tray.put_down_tray()
   
   rospy.loginfo("Going to dirty table to leave tray")
   
   rospy.loginfo("PAUSE")
   
   rospy.loginfo("Picking up stack of plates")
   
   rospy.loginfo("Setting plates on table")
   
   rospy.loginfo("Unstacking plates")

